™  . .  . 1*0  MOOT  FLEXIBILITY  FOR _ _ _ .. 

<U>  MASSACHUSETTS  INST  OF  TECH  CAMBRIDGE  ARTIFICIAL 
INTELLIGENCE  LAB  S  D  EPPINGER  ET  AL  MAV  88  AI-M-1046 
UNCLASSIFIED  N00814-85-K-0124  F/G  12/9 


4*1  V 


l  »<Y. 


Uf*L  LHi  3  I  T  I  tu 


5t;j«i''  ;L  »SV  ’  '  -  *  T'0N  Or  T“S  “*0  £  '»*•<.  Dai,  fruit'd) 


REPORT  DOCUMENTATION  PAGE 


i  r  number 


it.  OOVT  ACCCSSIOH  mo 


J  i  Lf  REkd  iMs^uctions 

1  1  TtfeTORWAlK-ETlNG  FORM 
>.  aecinicnt-s  catalog  number 


AIM  1046 


*  T1T1.E  find  JulNf/f) 


Modeling  Robot  Flexibility  for  Endpoint  Force 
Control 


s.  tymc  o*  rerort  *  nmoo  covered 

memorandum 


«  RERfORMING  ORO.  RERORT  NUMBER 


1.  AU  T  HOSflJ 


Steven  D.  Eppinger 
Warren  P.  Seering 


l.  contract  on  GRANT  NUMKKO) 

N00014-85-K-0124 


»  •caroauiNG  organi  z  ation  name  anO  adomess 
Artificial  Inteligence  Laboratory 
545  Technology  Square 
Cambridge,  MA  02139 


ToT  brooram  element  rroject,  task 

ASIA  *  VOAK  UNIT  NUMBERS 


U.  CONTNOLLINO  Office  NAME  ANO  AOONCSS 


Advanced  Research  Projects  Agency 
1400  Wilson  Blvd. 

Arlington,  VA  22209 


FNITITn-iriHi  TH  l?|.fl.TVIHT1 


Office  of  Naval  Research 
Information  Systems 
Arlington,  VA  22217 


May  1988 


is.  mmusea  ot.raocs 

ib 


IS.  BCCuniTY  CLASS.  All  ***•*) 


m.  DCC£  ASSIFIC  ATION/ OOWNOAAOIMO 


IS.  OISTAISUTION  STATIMINT  (•#  fAf«  *9pft) 


Distribution  is  unlimited. 


1?.  DlST  AllUTiOM  STATCMCNT  (•/  «*•  alimif  wimtf  fn  Hill  29,  If  Mffmnl  h+m  Rwfrt) 


IS.  RET  BOROS  (Caallaw  «n  nmit  ilO  II  DMmimdrr  mt*  IddmlUf  kf  AlacA 

robot  force  control 
robot  control 
robot  dynamics 
flexible  structures 


10.  ABSTRACT  fCMIftNM  «  NNIH  Alfa  II  »•«•••• y  m4  Mwl Ur  *7  MNt - , 

>  Dynamic  models  have  been  developed  in  an  attempt  to  match  the  response  of  a 
robot  arm.  The  experimental  data  show  rigid-body  and  five  resonant  modes. 

The  frequency  response  and  pole-zero  arrays  for  various  models  of  struc¬ 
tural  flexibility  are  compared  with  the  data  to  evaluate  the  characteristics 
of  the  models,  and  to  provide  insight  into  the  nature  of  the  flexibility  in 
the  robot.  Certain  models  are  better  able  to  depict  transmission  flexibility 
while  others  describe  types  of  structural  flexibility.  ^ ^ 


,  jAN  7|  1473  COITION  Of  •  NOV  CS  IS  OBSOLETE 
s/n  o:«}-#n-«*8i  i 


UNCLASSIFIED 


SECURITY  CLASSIFICATION  Of  THIS  » AOt  (Wkmt  Oat* 


^A?!i5wW!www! 


Massachusetts  Institute  of  Technology 
Artificial  Intelligence  Laboratory 


A.  I.  Memo  No.  1046 


May  1988 


Modeling  Robot  Flexibility  for  Endpoint  Force  Control 

Steven  D.  Eppinger 
Warten  P.  Seering 


Abstract 

Dynamic  models  have  been  developed  in  an  attempt  to  match  the  response  of  a  robot  arm.  The 
experimental  data  show  rigid-body  and  five  resonant  modes.  The  frequency  response  and  pole-zero 
arrays  for  various  models  of  structural  flexibility  are  compared  with  the  data  to  evaluate  the 
characteristics  of  the  models,  and  to  provide  insight  into  the  nature  of  the  flexibility  in  the  robot.  Certain 
models  are  better  able  to  depict  transmission  flexibility  while  others  describe  types  of  structural 
flexibility. 
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Introduction 


Manipulation  tasks,  such  as  mechanical  assembly  and  surface  following  involve  interaction 
between  the  robot  and  its  environment.  In  these  cases,  we  feed  back  the  resulting  contact  forces  in  hopes 
of  improving  performance.  Compliant  control  schemes  have  been  proposed  by  Raibert  and  Craig  [6], 
Salisbury  [7],  Whitney  [9],  and  others.  See  Whitney's  overview  [10]  for  a  more  complete  listing.  These 
methods  allow  the  use  of  signals  from  a  wrist-mounted  force  sensor  to  be  used  in  the  closed-loop  control 
of  the  robot  joints. 

While  the  prospect  of  using  the  sensed  force  to  improve  endpoint  force  command  tracking  and  to 
yield  better  disturbance  rejection  seems  quite  reasonable,  in  practice,  closed-loop  force  control  has 
extremely  limited  bandwidth.  Since  it  is  the  use  of  the  sensed  force  information  that  gives  rise  to  the 
stability  problems  in  an  otherwise  stable  system,  we  should  investigate  the  differences  between  joint 
position  control  and  endpoint  force  control. 

Joint  position  control  involves  joint  position  commands  and  measured  joint  position  feedback.  The 
closed-loop  bandwidth  is  generally  limited  only  to  the  open-loop  crossover  of  the  modeled  system. 
Specifically,  the  performance  can  be  predicted  by  modeling  the  compensator,  actuator,  and  rigid  links. 
(An  example  of  such  a  model  is  presented  here  in  the  section  entitled  "Rigid-Body  Dynamics".)  With  the 
joint  feedback  at  the  actuator  itself,  the  unmodeled  dynamics  in  the  transmission  and  links  become  less 
important. 

Endpoint  force  control,  on  the  other  hand,  involves  joint  force  commands  and  measured  endpoint 
force  feedback.  The  closed-loop  bandwidth  is  generally  only  a  small  fraction  of  the  open-loop  crossover 
of  the  modeled  system.  In  fact,  measured  performance  does  not  approach  that  predicted  by  modeling  the 
compensator,  actuator,  and  rigid  links.  Since  the  force  feedback  is  now  at  the  endpoint  rather  than  at  the 
actuator,  the  unmodeled  dynamics  in  the  transmission  and  links  become  vitally  important. 

A  good  model  demonstrates  the  difference  between  joint  position  control  and  endpoint  force 
control.  Previous  work  [3]  has  shown  the  effects  of  limited  actuator  bandwidth  and  of  structural 
flexibility.  The  term  colocated  control  is  used  to  describe  the  joint  position  control  scheme  above,  since 
the  sensors  used  for  feedback  are  located  at  the  same  points  on  the  flexible  structure  as  the  actuators  used. 
In  the  endpoint  force  control  scheme,  however,  the  sensors  are  at  the  robot  tip,  while  the  actuators  are  at 
the  joints.  The  sensors  are  separated  from  the  actuators  by  flexible  transmissions  and  flexible  links.  This 
is  termed  noncolocated  control  [5]. 

The  goal  of  this  research  is  to  develop  suitable  models  of  robot  flexibility,  with  the  aim  of  better 
understanding  the  causes  of  instability  and  improving  the  closed-loop  bandwidth  of  endpoint  force 
control.  A  series  of  lumped-mass  models  was  previously  developed  [2]  to  show  that  robot  flexibility 
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Figure  1:  Robot  Joint  Position  Control  and  Endpoint  Force  Control 
gives  rise  to  force  control  stability  problems,  since  this  is  a  noncolocated  scheme.  However,  lumped- 
mass  models  are  not  always  appropriate,  as  will  be  shown  here.  This  paper  begins  with  some 
experimental  robot  frequency  response  data.  The  limitation  of  rigid-body  models  is  shown,  and  then 
various  models  of  structural  flexibility  are  investigated.  Finally,  it  is  concluded  that  each  of  the  models 
may  be  useful  to  depict  the  dynamics  of  a  certain  type  of  robot  flexibility,  and  just  which  model  is  best  for 
a  given  robot  depends  upon  the  nature  of  the  flexible  elements  involved. 
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Experimental  Robot  Dynamics 

As  an  example  to  consider  throughout  this  paper,  we  will  consider  the  dynamics  of  the  MIT 
Cartesian  Assembly  Robot,  designed  and  built  at  the  MTT  Artificial  Intelligence  Laboratory.  The 
cartesian  gantry-type  structure  is  typical  of  a  large  class  of  robots.  While  this  configuration  is  different 
from  that  of  jointed  arms,  the  models  developed  here  may  be  applied  to  both  types. 

The  experiment  conducted  to  determine  the  frequency  response  of  one  of  the  axes  is  shown  in 
Figure  2.  The  hardware  used  includes:  a  Hewlett-Packard  structural  dynamics  analyzer;  the  robot’s 
Automatix  amplifier  and  Aerotech  motor;  the  X-axis  of  the  robot  structure;  and  a  Bruel  &  Kjaer 
accelerometer  and  charge  amplifier.  The  open-loop  transfer  function  desired  is  from  the  amplifier’s 
'elocity  command  input  (which  is  normally  the  digital  controller’s  output)  to  the  tip  motion.  The  input 
given  to  the  amplifier  was  band-limited  white  noise  generated  by  the  HP  analyzer.  The  output  measured 
was  tip  acceleration  of  the  robot  X-axis  tested.  The  analyzer  compares  the  frequency  components  of  the 
input  and  output  signals,  and  calculates  a  transfer  function  for  plotting. 


analyzer 


Figure  2:  Robot  Test  Setup 

The  transfer  function  for  the  X-axis  is  shown  in  Figure  3  as  measured  in  the  experiment  described. 
The  dominant  structural  modes  appear  to  be  roughly  at  11,  38,  44,  67,  and  77  Hz.  We  would  like  to 
develop  a  dynamic  model  of  this  frequency  response  which  can  be  used  in  the  design  of  a  superior  force 
control  scheme. 
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Rigid-Body  Dynamics 


Before  attempting  to  understand  the  nature  of  the  flexible  modes  of  the  robot,  we  should 
investigate  the  theoretical  rigid-body  behavior.  It  is  this  response  which  limits  even  the  joint  position 
control  closed-loop  bandwidth.  The  term  rigid-body  refers  to  the  robot  axis  modeling  only.  This  model 
must  still  include  the  significant  compensator,  amplifier,  and  motor  dynamics. 

A  sketch  of  the  rigid-body  dynamic  model  is  shown  in  Figure  4.  The  input  to  this  model  is  the 
velocity-command  voltage  given  to  the  preamplifier  (this  signal  usually  comes  from  the  digital 
controller).  The  preamplifier  includes  analog  tachometer  feedback  and  a  gain.  The  power  amplifier  is 
configured  as  a  current  (transconductance)  amplifier,  which  is  simply  a  voltage  amplifier  with  sensed 
current  feedback.  The  power  amplifier  is  actually  a  pulse-width  modulated  device  with  sufficiently  high 
su  itching  frequency  that  it  can  be  modeled  as  a  linear  amplifier.  The  current  feedback  comes  from  the 
coupled  motor  model.  (Note  that  modeling  the  power  amplifier  simply  as  a  current  amplifier  would,  by 
causality,  force  us  to  ignore  the  motor  dynamics.)  The  motor  input  is  its  terminal  voltage.  The  motor 
electrical  characteristics  are  constant  inductance  and  resistance,  a  torque  constant,  and  back  EMF.  The 
motor  torque  output  is  then  proportional  to  the  current.  The  transmission  ratio  (ball  screw  pitch)  converts 
motor  torque  to  force  on  the  axis  rigid-body.  The  robot  effective  mass  to  consider  here  is  the  total 
moving  mass  of  the  robot,  plus  the  reflected  inertias  of  the  rotor  and  screw.  We  also  include  some 
viscous  damping  to  ground,  but  no  stiffness  to  ground,  since  the  axis  can  be  positioned  anywhere  by  the 
actuator.  Finally,  the  rest  of  the  feedback  loops  are  closed,  with  the  velocity  again  passing  through  the 
transmission  to  get  the  motor  speed. 
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Figure  4:  Rigid-Body  Robot  Model 


Along  with  the  flexibility,  the  many  nonlinearities  present  in  the  actual  system  are  also  neglected 
in  this  model.  The  most  significant  of  these  nonlinearities  are  amplifier  saturation  and  bearing  friction. 
These  effects  are  considered  in  the  simulation  used  for  the  controller  design. 

The  transfer  function  for  the  linear  rigid-body  model  is  then,  from  amplifier  input  to  tip  velocity 


output: 
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We  have  a  second-order  transfer  function  which  becomes  third  order  when  endpoint  position  is  made  the 
output  by  adding  a  free  integrator.  To  compare  the  frequency  response  with  the  experimental  data, 
however,  we  must  add  a  differentiator  instead,  to  yield  tip  acceleration,  which  was  measured. 
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The  rigid-body  model  response  is  shown  in  Figure  5.  We  have  depicted  the  overall  magnitude  and 
phase  response  of  the  robot  without  its  structural  dynamics.  We  now  seek  a  model  of  the  structural 
resonances. 
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Figure  5:  Rigid-Body  Model  Acceleration 


iiM'.nif 


Polynomial  Resonance  Model 


Since  the  structural  resonances  are  well  within  the  range  of  interest,  we  need  to  model  these 
dynamics  also.  A  simple  model  of  these  dynamics  can  be  obtained  by  constructing  a  polynomial  transfer 
function  to  represent  the  resonances  in  the  transfer  function  which  was  obtained  by  test.  The  fitted 
polynomial  function,  when  cascaded  with  the  rigid-body  model  derived,  should  match  both  the  magnitude 
and  phase  of  the  experimental  transfer  function. 

We  will  attempt  to  match  the  first  five  dominant  modes  in  the  data.  Moreover,  we  propose  to  do  so 
by  cascading  five  simple  resonance  transfer  functions .  each  of  w  hich  has  the  following  form: 

fflj  s2* l^js+iol 
Rt(s)  =  — - 

Each  simple  resonance  transfer  function  includes  a  pair  of  poles  and  a  pair  of  zeros  only.  Each  is  also 
scaled  to  have  essentially  no  effect  on  the  response  at  ca  <  min[copj,  to.,-]. 

The  overall  transfer  function  that  should  match  the  data  is  then 

5 

GP(S )  =  G>)nw 

.=1 

where  Garb(s)  is  the  rigid-body  model  transfer  function  of  tip  acceleration  output  to  velocity  command 
input. 

The  matching  of  the  data  takes  place  as  follows: 

For  each  resonance  to  be  matched,  starting  with  the  lowest  frequency: 

1.  Compare  \Gp{jti))  |  with  the  experimental  transfer  function  magnitude  plot. 

2.  Find  the  peak  corresponding  to  the  resonance,  and  set  <api  to  the  peak  frequency. 

3.  Find  the  trough  corresponding  to  the  resonance,  and  set  0).,  to  the  trough  frequency. 
(Typically,  to.,  =  1.1  (X)pi  for  structural  modes.) 

4.  Choose  C,pi  to  match  the  height  of  the  peak.  (Typically,  C,pi  =  .05  for  structural 
modes.) 

5.  Choose  to  match  the  depth  of  the  trough.  (Typically.  =  .05  for  structural 
modes.) 

Note  that  this  method  uses  the  magnitude  plots  only,  and  we  construct  a  transfer  function  to  match 
these.  The  phase  plots  should  match  also,  if  the  data  to  be  matched  actually  represent  a  minimum-phase 
system.  Figure  6  shows  the  frequency  response  of  the  polynomial  resonance  model,  which  can  be 
compared  to  the  experimental  response  data  in  Figure  3. 

Since  the  resonance  model  is  made  up  by  cascading  the  simple  resonance  transfer  functions  with 
the  rigid-body  model,  its  pole-zero  array  includes  the  two  poles  of  the  rigid-body  model,  the  zero  at  the 


Lumped-Mass  Models 


The  fitted-polynomial  resonance  model  provides  an  excellent  match  to  the  actual  system  response, 
however,  it  lacks  the  ability  to  lend  physical  insight  into  the  behavior  exhibited.  To  improve  this 
situation,  we  would  like  to  develop  a  model  of  the  robot  structural  flexibility  which  has  some  physical 
relevance  to  the  actual  hardware. 


We  first  investigate  adding  flexibility  to  the  rigid-body  model  discussed  earlier.  Consider  a  model 
of  the  robot  axis  which  includes  flexibility  between  the  actuator  and  the  tip.  Figure  8a  shows  the  robot 
represented  by  two  masses  coupled  with  a  spring.  This  flexible  element  might  depict  a  transmission 
compliance  or  the  flexure  of  a  structural  element  between  the  actuator  and  the  tip.  This  configuration 
attempts  to  mcdel  one  mode  of  vibration  in  the  robot.  To  depict  the  first  five  modes,  we  would  need 
more  vibrating  masses. 

Consider  the  substitution  of  a  lumped-mass  model,  with  five  springs  and  six  masses  in  series. 
Figure  8b,  whose  resonant  frequencies  mat'  ii  the  first  five  resonant  modes  of  the  robot  data.  Previous 
w  ork  [2]  has  analyzed  lumped-mass  models  of  this  type  to  show  that  for  each  mode  of  vibration  modeled 
between  the  actuator  and  endpoint,  two  poles  are  added  while  only  one  zero  is  added  in  the  actuator-to- 
endpoint  transfer  function.  However  inspection  of  the  experimentally-obtained  robot  transfer  function 
implies  that  the  correct  model  of  the  robot  flexibility  include  two  zeros  for  each  pair  of  poles  added.  The 
frequency  response  of  this  lumped-mass  model  cannot  possibly  match  the  data,  since  the  transfer  function 
has  too  few  zeros! 


We  now  consider  adding  the  resonant  dynamics  elsewhere  in  the  lumped-mass  model. 
Specifically,  suppose  that  the  actuator  and  tip  are  still  dynamically  colocated  on  the  flexible  structure,  but 
there  exist  flexible  elements  on  the  supporting  side  of  the  actuator  (in  the  .obot  base,  or  frame).  Figure  8c 
shows  this  configuration.  The  transfer  function  from  force  input  to  motor  (or  tip)  output  velocity  now  has 
two  zeros  and  three  poles.  So  two  poles  and  two  zeros  have  now  been  added  to  the  original  rigid-body 
lumped-mass  model  by  the  base  dynamics. 

This  is  a  plausible  model  for  a  class  of  robot  flexibility;  however,  it  results  in  only  colocated 
transfer  functions.  That  is,  it  does  not  address  the  difference  between  joint  position  control  and  endpoint 
force  control. 
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Bending  Beam  Models 

In  search  of  models  of  structural  flexibility  which  allow  transfer  functions  to  be  derived  for  outputs 
at  various  points  on  the  structure,  and  also  allow  resonant  modes  to  be  added  one  at  a  time,  we  attempt  to 
model  a  cantilever  beam  in  bending.  We  model  the  beam  in  bending  for  two  reasons:  first,  the  lumped- 
mass  models  considered  above  seem  to  be  discrete  models  of  beams  in  axial  loading 
( tension/compression),  and  they  failed  to  properly  represent  the  robot  structural  modes;  and  second,  the 
robot  structural  modes  actually  look  like  they  are  comprised  of  mostly  bending. 

Figure  9  shows  the  distributed-parameter  beam  robot  model.  We  consider  the  cantilever  beam 
shown  with  a  sliding  constraint  at  one  end  and  free  at  the  other  end.  At  the  sliding  end,  we  apply  the 
actuator  force  and  measure  the  actuator  motion.  At  the  free  end,  we  measure  the  tip  displacement. 


/W'jV  p’E>i>A>i 

Figure  9:  Distributed-Parameter  Beam  Robot  Model 

Derivation  of  equations  of  motion  for  such  a  beam  is  fairly  simple,  however,  we  desire  transfer 
functions.  Vaughan  [8]  has  developed  a  method  for  the  derivation  of  such  transfer  functions,  although  he 
does  not  present  this  particular  set  of  end  conditions.  Using  his  procedure,  however,  we  can  derive  the 
following  relations  representing  the  colocated  (actuator)  and  noncolocated  (tip)  transfer  functions  for  the 
sliding-free  beam  shown. 

Vaci^  _  -i  (S2+C2)2+2S2+2C2+1 

F(s)  ~  P  (52+c2)2-4C5-1 

Vf!  =  -i€Tp- 

F(s)  (S2+C2)2-4CS-1 

where  S  =  e~'lTPsia'JTp 
C  =  e~^Tp  cos  ylfp 


T  =  i/2 

and  E ,  I,  p,  A,  and  /  are  the  beam  parameters. 


These  transfer  functions  are  non-polynomial,  and  have  an  infinity  of  poles  and  zeros.  Nevertheless,  we 


can  plot  their  frequency  response  in  the  normal  manner,  by  substituting  s  =  yco.  Figure  10  shows  these 
frequency  response  plots,  using  (Vaughan’s)  sample  beam  parameters. 
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Figure  10:  Bode  Plots  for  the  Distributed-Parameter  Beam  Model 

Now,  to  investigate  the  suitability  of  this  type  of  beam  model  to  our  robot  data,  we  consider  the 
poles  and  zeros  of  these  transfer  functions.  While  we  cannot  explicitly  solve  for  the  poles  and  zeros  as 
the  roots  of  the  numerator  and  denominator  polynomials  of  the  transfer  functions,  we  can  still  Find  the 
poles  and  zeros  as  the  points  in  the  5-plane  at  which  the  transfer  function  becomes  infinite  or  zero, 
respectively.  In  fact,  by  doing  so,  we  can  construct  polynomial  approximations  to  these  transfer  functions 
which  are  valid  up  to  any  frequency.  Shown  in  Figure  1 1  are  the  pole-zero  arrays  for  the  colocated  and 
noncolocated  transfer  functions  of  the  beam.  These  polynomial  transfer  functions  match  the  response  of 
the  real  beam  transfer  functions  perfectly  through  the  5th  modes.  The  colocated  beam  transfer  function 
has  poles  and  zeros  in  alternating  pairs  along  the  yen  axis.  The  noncolocated  beam  transfer  function  has 
pairs  of  poles  along  the  yea  axis  (in  the  same  locations,  since  the  two  transfer  functions  have  the  same 
characteristic  equation),  but  the  zeros  are  spread  out  symmetrically  along  the  positive  and  negative  real 
axes.  The  real  zeros  appear  in  these  "pairs"  so  as  to  contribute  no  net  phase  shift.  (Without  these  zeros. 


Colocated  TF  Noncolocated  TF 

Figure  11:  Colocated  and  Noncolocated  Pole-Zero  Arrays  for  the 
Distributed-Parameter  Beam  Model 

the  magnitude  response  drops  off  much  too  fast,  and  does  not  match  at  all.) 

The  nonminimum  phase  zeros  which  appear  in  the  noncolocated  transfer  function  of  the 
distributed-parameter  beam  robot  model  are  an  interesting  finding.  Similar  non-minimum  phase 
properties  have  been  reported  by  Cannon  and  Schmitz  in  their  very  flexible  beam  structure  [1].  They  are 
curious  because  they  do  not  appear  in  any  of  the  lumped-mass  models  derived  above.  Is  this  because  the 
distributed-parameter  beam  mode!  uses  distributed  parameters  instead  of  lumped?  Or  is  modeling  the 
bending  instead  of  the  tension/compression  the  significant  difference  which  gives  rise  to  the  nonminimum 
zeros? 

We  hypothesize  that  the  right-half  plane  zeros  come  from  the  bending  effects  and  not  the 
distributed  nature  of  the  model.  However,  to  find  out  for  sure,  we  derive  transfer  functions  for  a  lumped- 
parameter  bending-beam  model  shown  in  Figure  12.  This  model  is  a  limited  form  of  the  lumped- 
parameter  Timoshenko  beam.  Here  the  left-end  mass  slides,  while  the  right-end  mass  is  free  to  rotate  and 
translate,  as  in  the  disuibuted-parameter  model  discussed  above. 

The  equations  of  motion  for  this  model  can  be  derived  and  we  can  solve  for  the  transfer  functions 
from  the  input  force  to  various  outputs.  We  will  describe  two  such  transfer  functions,  whose  pole-zero 
arrays  are  shown  in  Figure  13.  The  colocated  transfer  function,  from  the  force  input  to  the  position 
output,  xacr  is  minimum  phase.  The  noncolocated  transfer  function,  from  the  force  input  to  the  position 
output,  xtip,  is  nonminimum  phase.  In  fact,  this  noncolocated  transfer  function  also  has  a  "pair"  of  real 
zeros  at  equal  frequencies  on  the  positive  and  negative  real  axes. 
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Figure  13:  Colocated  and  Noncolocated  Pole-Zero  Arrays  for  the 
Lumped -Parameter  Beam  Model 

The  appearance  of  the  nonminimum  phase  zeros  in  the  noncolocated  transfer  functions  of  both  of 
the  bending-beam  models  again  leads  us  to  dismiss  these  models,  since  the  right-half  plane  zeros  do  not 
appear  in  the  experimental  data.  The  polynomial  fit  to  the  experimental  data  showed  pairs  of  poles  and 
zeros  lining  up  just  to  the  left  of  the  ji o  axis.  The  distributed-parameter  beam  model’s  colocated  transfer 
function  has  the  right  numbers  of  poles  and  zeros  for  each  mode  and  the  correct  arrangement  thereof  in 
the  s-plane.  While  this  model  looks  promising,  it  does  not  predict  any  instability  for  endpoint  force 
control  that  would  not  be  present  for  joint  position  control. 


Discussion 


We  have  shown  experimental  data  representing  the  frequency  response  of  a  robot  used  in  our 
laboratory.  We  then  developed  a  series  of  models  in  an  attempt  to  understand  these  data. 

The  rigid-body  robot  model  is  capable  of  matching  the  overall  frequency  response,  with  the 
exception  of  the  resonances.  This  model  considers  only  the  amplifier,  motor,  and  effective  rigid-body 
mass  of  the  arm. 

The  polynomial  resonance  model  matched  the  robot  frequency  response  quite  well,  including  the 
first  five  major  resonant  modes.  This  model  consists  of  the  rigid-body  model,  cascaded  with  two  poles 
and  two  zeros  for  each  flexible  mode.  Despite  the  superior  match,  this  mathematical  model  bears  no 
physical  significance  with  regard  to  the  actual  system. 

The  lumped-mass  models  have  been  analyzed  previously,  and  are  well  understood.  When  used  to 
depict  flexibility  between  the  actuator  and  tip.  these  models  add  for  each  resonance  a  pair  of  poles,  and 
only  one  zero  to  the  rigid-body  model’s  actuator-to-endpoint  transfer  functions.  When  used  to  describe 
flexure  of  the  robot  base  or  frame,  these  models  add  two  zeros  with  each  pair  of  poles.  The  former  of 
these  configurations  is  unable  to  match  the  data,  while  the  latter  lacks  the  ability  to  provide  both  colocated 
and  noncolocated  transfer  functions. 

The  distributed-parameter  beam  model  showed  a  striking  difference  between  the  pole-zero 
arrays  of  its  colocated  and  noncolocated  transfer  functions.  Specifically,  the  colocated  transfer  function 
has  poles  and  zeros  alternating  along  the  /co  axis,  while  the  noncolocated  transfer  function  has  the  same 
poles,  with  its  zeros  spread  out  along  the  positive  and  negative  real  axes.  The  presence  of  these 
nonminimum  phase  zeros  explains  why  at  high  gain  the  noncolocated  control  becomes  unstable. 

The  lumped-parameter  beam  model  showed  the  same  nonminimum  phase  characteristics  as  its 
distributed-parameter  counterpart.  We  conclude  that  the  bending  modes  have  significantly  different 
dynamic  behavior  than  axial  vibrations  in  beams. 

The  two  striking  observations  about  these  modeling  efforts  are: 

•  Only  the  polynomial  resonance  model  matched  the  experimental  data  well.  If  a  high- 
bandwidth  model  is  required,  this  method  yields  an  excellent  result,  although  it  provides  little 
or  no  physical  insight. 

•  It  is  possible  for  a  tip  sensor  and  joint  actuator  to  be  physically  noncolocated.  but 
dynamically  colocated.  That  is,  while  they  are  separated  by  flexible  elements  on  the  robot 
structure,  for  some  finite  bandwidth,  they  'move  together".  The  sensor  response  is  equal  in 
phase  to  the  actuator  input  throughout  a  given  frequency  range.  Above  this  bandwidth  they 


may  be  dynamically  noncolocated. 


We  can  divide  the  sources  of  robot  flexibility  into  three  categories: 

1 .  base  flexure 

2.  transmission  compliance 

3.  link  flexure 

The  transmission  compliance  is  the  simplest  to  model.  We  would  suggest  an  appropriately  chosen 
lumped-mass  model.  Base  or  link  flexibility  is  likely  to  more  closely  resemble  beam(s)  in  bending  rather 
than  beam(s)  in  tension  or  compression,  and  the  lumped  masses  in  series  are  a  discrete  approximation  to  a 
beam  under  axial  loading.  We  therefore  recommend  a  beam  model  for  the  base  or  link  flexibility.  Even  a 
lumped-mass  model  of  a  beam  in  bending  displays  nonminimum  phase  zeros  at  frequencies  equal  to  the 
minimum  phase  zeros  that  appear.  Finally,  base  and  link  flexure  differ  significantly  in  that  base  flexure 
allows  the  joint  actuators  and  tip  sensors  to  remain  dynamically  colocated,  while  link  flexure  may  not. 
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